function dydt=o_test(t,y,G,P,k)
% y[1]=pos_x; y[2]=pos_y; y[3]=angle;
dydt = [y(2); (1-y(1)^2)*y(2)-y(1);0.1];
